summaryrefslogtreecommitdiffstats
path: root/src/core/hle/service/hid/irsensor/clustering_processor.h
blob: dc01a8ea78cfe0205c0dc9fa4c5075a6737b3b8a (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
// SPDX-FileCopyrightText: Copyright 2022 yuzu Emulator Project
// SPDX-License-Identifier: GPL-3.0-or-later

#pragma once

#include "common/common_types.h"
#include "core/hid/irs_types.h"
#include "core/hle/service/hid/irs_ring_lifo.h"
#include "core/hle/service/hid/irsensor/processor_base.h"

namespace Core::HID {
class EmulatedController;
} // namespace Core::HID

namespace Service::IRS {
class ClusteringProcessor final : public ProcessorBase {
public:
    explicit ClusteringProcessor(Core::HID::HIDCore& hid_core_,
                                 Core::IrSensor::DeviceFormat& device_format,
                                 std::size_t npad_index);
    ~ClusteringProcessor() override;

    // Called when the processor is initialized
    void StartProcessor() override;

    // Called when the processor is suspended
    void SuspendProcessor() override;

    // Called when the processor is stopped
    void StopProcessor() override;

    // Sets config parameters of the camera
    void SetConfig(Core::IrSensor::PackedClusteringProcessorConfig config);

private:
    static constexpr auto format = Core::IrSensor::ImageTransferProcessorFormat::Size320x240;
    static constexpr std::size_t width = 320;
    static constexpr std::size_t height = 240;

    // This is nn::irsensor::ClusteringProcessorConfig
    struct ClusteringProcessorConfig {
        Core::IrSensor::CameraConfig camera_config;
        Core::IrSensor::IrsRect window_of_interest;
        u32 pixel_count_min;
        u32 pixel_count_max;
        u32 object_intensity_min;
        bool is_external_light_filter_enabled;
        INSERT_PADDING_BYTES(3);
    };
    static_assert(sizeof(ClusteringProcessorConfig) == 0x30,
                  "ClusteringProcessorConfig is an invalid size");

    // This is nn::irsensor::AdaptiveClusteringProcessorConfig
    struct AdaptiveClusteringProcessorConfig {
        Core::IrSensor::AdaptiveClusteringMode mode;
        Core::IrSensor::AdaptiveClusteringTargetDistance target_distance;
    };
    static_assert(sizeof(AdaptiveClusteringProcessorConfig) == 0x8,
                  "AdaptiveClusteringProcessorConfig is an invalid size");

    // This is nn::irsensor::ClusteringData
    struct ClusteringData {
        f32 average_intensity;
        Core::IrSensor::IrsCentroid centroid;
        u32 pixel_count;
        Core::IrSensor::IrsRect bound;
    };
    static_assert(sizeof(ClusteringData) == 0x18, "ClusteringData is an invalid size");

    // This is nn::irsensor::ClusteringProcessorState
    struct ClusteringProcessorState {
        s64 sampling_number;
        u64 timestamp;
        u8 object_count;
        INSERT_PADDING_BYTES(3);
        Core::IrSensor::CameraAmbientNoiseLevel ambient_noise_level;
        std::array<ClusteringData, 0x10> data;
    };
    static_assert(sizeof(ClusteringProcessorState) == 0x198,
                  "ClusteringProcessorState is an invalid size");

    struct ClusteringSharedMemory {
        Service::IRS::Lifo<ClusteringProcessorState, 6> clustering_lifo;
        static_assert(sizeof(clustering_lifo) == 0x9A0, "clustering_lifo is an invalid size");
        INSERT_PADDING_WORDS(0x11F);
    };
    static_assert(sizeof(ClusteringSharedMemory) == 0xE20,
                  "ClusteringSharedMemory is an invalid size");

    void OnControllerUpdate(Core::HID::ControllerTriggerType type);
    void RemoveLowIntensityData(std::vector<u8>& data);
    ClusteringData GetClusterProperties(std::vector<u8>& data, std::size_t x, std::size_t y);
    ClusteringData GetPixelProperties(const std::vector<u8>& data, std::size_t x,
                                      std::size_t y) const;
    ClusteringData MergeCluster(const ClusteringData a, const ClusteringData b) const;
    u8 GetPixel(const std::vector<u8>& data, std::size_t x, std::size_t y) const;
    void SetPixel(std::vector<u8>& data, std::size_t x, std::size_t y, u8 value);

    // Sets config parameters of the camera
    void SetDefaultConfig();

    ClusteringSharedMemory* shared_memory = nullptr;
    ClusteringProcessorState next_state{};

    ClusteringProcessorConfig current_config{};
    Core::IrSensor::DeviceFormat& device;
    Core::HID::EmulatedController* npad_device;
    int callback_key{};
};
} // namespace Service::IRS